#include "./pick_service.h"
#include "../../driver/arm/elevator_motor.h"
#include "../../driver/arm/parts.h"
#include "../../driver/arm/arm_motor.h"

namespace service {

using namespace utils;
using namespace driver;

Error init() {
    Error err = armMotor->init();
    if (err) {
        goto finish;
    }
    err = elevatorMotor->run_with_mm(320);
    if (err) {
        goto finish;
    }
    err = armMotor->run(1979, 1008);
    if (err) {
        goto finish;
    }
finish:
    return err;
}

}
